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1 .0 INTRODUCTION 


This report sunmarizes the matheroatf cal developments and their computer 
program implementation for the Space Shuttle propulsion parameter estimation 
project. The estimation approach chosen is the extended Kalman filtering 
with a modified Gbryson-Rrazier smoother. This estimation technique has 
been used on previous aerodynamic coefficient parameter estimation efforts. 

Its use here is motivated by the objective of obtaining better estimates 
than those available from filtering cuid to eliminate the lag associated 
with filtering. 

'Ihe estimation technique uses as the dynamical process the six degree 
equations~of -motion resulting in twelve state vector elements. In addition 
to these are mass and solid propellant bum depth as the "system" state 
elements. The "parameter" state elements can include aerodynamic coefficient > 
inertia, center-of -gravity , atmospheric wind, etc. deviations from referenced 
values. Propulsion parameter state elements have been included not as 
options just discussed but as the main parameter states to be estimated. 

The mathematical developments have been completed for all these parameters. 
Since the systems dynamics and measurement processes are non-linear functions 
of the states , the mathematical developments are taken up almost entirely 
by the linearization of these equations as required by the estimation 
algorithms . 

This estimation approach has the objective of using all available 
measurements. These measurements include ground based radar tracking, 
on-board inerti.ally stabilized platform accelerometer and attitude data, 

SSME pressurants/f uel flow rates and power level, and SRB head pressure. 
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1h« estimation algorithm is implemented to process each o£ these measure- 
ments separately with the assiimption that the errors associated with th^se 
measurements are uncorrelated. 

Ihe computer programs have be«i developed in a highly modular structure 
to facilitate understanding » checkcMit and, if necessary, modification. 

Ihe computer programs reside on NASA's VAX 1 computer system in the HOSC 
facility. Approximately eighty sepaurate routines have been developed to 
implement this estimation technique. As specified by the ITYPE variable, 
the FILTER program can provide three modes of data processing. Ihese 
include: ITYPE > 0 to generate synthetic measurement data, ITYPE - 1 to 

provide optimal estimates based on the extended Kalman filter algorithm, 
and ITYPE > 1 to propagate the state error covauriance matrix with no 
updating from the measurement process, ihe SMOOTH program provides esti- 
mates of the system and parauneter state elements from the filter estimates 
provided as input. 

Preliminary results indicate that the propulsion parameters strongly 
affect the states and associated measurements. Ihe resulting estimates 
should be rapidly ccxiverged upon by the filter algoriwhm and accuracy 
improved upon by the smoother algorithm. These preliminary results will 
be discussed later in this report. 

This report. Volume I, is organized as the following. In Section 2.0 
the filtering and smoothing algorithms are presented. Section 3.0 contains 
the system and parameter state models, their linearization, the measurement 
equations, and their linearization with respect to the state elements. The 
computer programs are described in Section 4.0 along with some preliminary 
results. Appendices A, B and C contain auxiliary partial derivatives 
(linearizations) and Appendix D contains the aerodynamic coefficient model 
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and data used as the referenced model in the estimation program. Volume 
II contains the computer listings of the FILTER and SMCX3TH programs with 


associated example input and output data listings 
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2.0 FILTERING AND SMOOTHING ALGORITtM 

The Space Shuttle Parameter Estimation Arogram utilizes optimal 
estimation techniques to provide estimates of the jaropulsion system 
parameters. The technique selected is the extended Kalman filter and 
the modified Bryson-Frazier smoother. By modeling the propulsion system 
parameters as time correlated random variables j improved estimates of 
these parameters are obtained and are properly time phased by removing 
the filter induced lag by using the combined f il ter /smoother . The 
smoother also provides Improved estimates of the initial state estimates . 

The system > in state-space notation, is modeled as the continuous 
dynamical system disturbed by additive Gaussian white noise 

X = ^(x(t) , t ) + G(t ) w(t) + u_(t) , x(o) “ (1 ) 

%rtiere 

X = n -dimensional state vector 

X ■ Gaussian initial condition vector with covariance P 
—o o 

w(t) - p-diraensional v^hite, zero-mean vAite Gaussian noise with 
covariance 

E[w(t) w^(t)] = Q(t) 6(t - t) 

u(t) = n -dimensional control vector. 

The elements of the vector x(t) represent vehicle position, velocities, 
attitudes, angular rates, aerodynamic and propulsion parameters, measure- 
ment biases, etc. Elements of u(t) include known control inputs such 


as SSME power level commands. 
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Die syat«n described by equation (1) is observed at discrete times < tj^> 
with not all states being directly measured. Some measur«nents are non- 
linear functions of the elmnents of the state w-wtor x^t) . In general 
the measurement process is described as 

where 

z, s m-^limensional observation vector 
He 

h^ = functional representation of the measurements in terms of 
the states 

^ = m -dimensional 1 zero -mean > vAiile Gaussian noise sequence with 
covariance 

E[v. v^] = R. 6. , 

-a -0 1 

Examples of the elements of the observation vector ^ include radar 
measurements of range, azimuth, and elevation from the radar site to the 
vehicle. 

It is assumed that the system process noise vector w(t) and the 

measurement noise vector y are uncorrelated. Also, the system state 

initial condition vector x is not correlated with either of these two 

— o 

noise vectors. Therefore 

E[w(t) v^] = 0, E[w(t) x"^] = 0, E(x vjl = 0 

where the superscript T denotes transpose. For later reference, the 
following matricies are defined 
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8f(x(t), t) 

and 

ah(x(t. ) ) 

•fliese Matricies are linearizations of the dynamics and measurement models 
respectively, evaluated about either a nominal or reference value of the 
state, or about the state estimate. 

2.1 Extended Kalman Filter Algorithm 

The extended Kalman filter algorithm is in essence a conventional 
linear Kalman filter algorithm applied to a mathematical model resulting 
from the linearization of the system model equation (1), and raeasuriment 
process, equation (2), about a current state estimate. Ihe filter yields 
optimal estimates if the linearization is accurate, i.e., the state esti- 
mate closely approximates the true state. The derivation of the algorithm 
can be found in reference [1]. 

The algorithm proceeds as follows. After initialization of the state 
estimate and covariance, the state estimate and covariance are propagated 
forward in time until a measurement update is available, by 

X = f (x(t), t) , t < tj^ (5) 

and 

P(t) = F(x(t), t) P(t) + P(t) F(x(t), t)^ + G(t) Q(t) G(t)’^ 


( 6 ) 
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At the measurement time, the state estimate and covariance are updated 
by 


4(t) - S^(-) + (7) 

and 

P^C+) - (I - H^(§^(-))) P^(-) (8) 

where the (-) and (-i-) represent the ai^rupriate values just before 
and just after the update. The updated values are used to reinitialize 
the time propagation equations (3) and (4) for integrating up to the next 
measurement time. The Kalmem gain matrix is computed as 

This algorithm is repeated until the last time point > t^, is processed. 

For later use in the smoother algorithm, various combinations of the state 
estimates (x^), measurements (£) , linearized dynamics matrix (F) and 
measurement matrix (H), measurement noise covariance (R) and estimation 
error covariance matrix <P) must be stored for each time instant to be 
processed by the smoother algorithm. 

2.2 Modified Bryson -Frazier anoother Algorithm 

The operation of the smoother algorithm is similar to the filter 
algorithm except in reverse time. The derivation of this smoother algorittm 
is found in reference [2]. This fixed interval smoothing algorithm pro- 
vides optimal estimates given all the measurements in comparison to the 
filtering algorithm providing optimal estimates given the previous 
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measuremontB procassed. Tharefora tha amoothar providaa improvad astimataa 
in addition to ramovlng tha tima lag Induced by tha filter algorithm. 

Ihe smoothing algorithm adjoint variables > ^ and A are "initialized” 
at tha final time processed by the filter, T, 

X(T-) - Pjj hJ + (z^ - H^(Xjj(-))) 6^ (10) 

N,T 

and 

*(T-> ■ H>„ hJ . R^r’ 8 (11) 

N,T 

If T is not an observation time, ^ and A are zero. Ttie adjoint 
variables are propagated in reverse time to the next previous measurement 
time by 

X - - P(x(t), t) X , 1 t < tj^^^ (12) 

A - - F(x(t), t)"^ A - A F(x(t), t) (13) 

At the time of an available measurement, t^, the adjoint variables 
are updated by 

X(-) . X( + ) - H^(1^ Pjc ^ ^ 

+ + \) i( + )) (M) 

and 

A(-) = (I - \ A( + ) (I - H|^) + F^(H^ )"’ (15) 


! 

i 

I 




9 


ORIGINAL PAC:U 
OF POOR QUALITY 


ni« anioothar atata astimata and arror oovarianca ara obtalnad using tha 
filtar astimata and oovarianca and tha adjoint variablas by 

x*(t) - x(t) - P(t) X(t) (16) 

and 

P*(t) - P(t) - P(t) A(t) P(t). (17) 

Dua to tha potantial numbar of tima points to ba procassadi smoothar 
astimatas may only be coroputad at tha discrata maasuramant timas. For 
this approach tha i»ropagation aquations (10) and (11) ara raplacad by 

and 

T 

where 9 , is the state transition matrix formed with tha linaarizad 
ic 

dynamics matrix F to propagate the adjoint variable from tima t^^^^ 
to time t^. The algorithm continues in reverse tima until tha initial 
time is reached. 

2.3 Iterations with the Filter/anoother Algorithm 

The performance of the f ilter/smoother algorithm is a direct result 
of the accuracy of the linearization. Repeated operations of the algorithms 
with ad;,jstments in initial state estimates and covariance in each cycle 
can yield improved estimates. This technique is known as global iterated 
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tutoring as deflnad in r«f«r«nca [3]. Each cycle of operating the 
algorithms would yield increasing improvements in the state estimates. 

This feature of the algorithm operation is of special interest to 
the propulsion parameter estimation ^oblem us^ng the NASA predictive 
models. Initial » or nominal* values of the parameters of interest can 
be used to obtain the necessary partial derivatives indicated earlier, 
from operating the algorithm improved estimates of those parameters are 
obtained. Using these improved estimates* more accurate partial deriva- 
tives are obtained for use in the algorithms. This process is continued 
until there is in essence no change in tlui partial derivatives or quality 
of the state estimates. If the linearization is accurate, the measure- 
ment residual should be a white noise process with known covariance. 
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3.0 FILTCR/SMOCmffiR ALCORITWI SYSTEM AND >CASUREMSNT MM)EL 

lh« u«ttfuln«cs of th« filtor/Mnoothor algorithm la to provida eati- 
mataa of tha ayatam atatta from tha obaarvad motion and dynamica %fhiia 
tiia ayatam la 'Irlvan by icnoan and unkno«m alamanta. lhaaa unkno%m alamanta 
ara alamanta of tha ayatam atata vactor to ba aatlmatad. Tha avolutlon of 
motion raiiultlng from thaaa kno«m and unknown alamanta la aaaumad to ba 
aultably rapraaantad for thla atudy by a alx dagraa-of-fraadom (6 DOF) rigid 
body aquatlona of motion. Thaaa aguatlona ura praaantad and dlacuaaad In 
aactlon 3.1 . 

Tb implamant thaaa aquatlona into th«- flltar/amoothar algorithm 
praaantad In aaction 2.0, a linaarlzatlon of tha ayatim atata and maaaura- 
mont modala la raqulr«td. Thaaa llnaarlzad aquatlona ara praaantad in 
aactlon 3.2. 


3.1 Equations of Motion and Maaaur«nant Equationa 


3.1.1 Rigid Body Equationa o.. Hotlon 

Tha rata of changa of vahlcla valoclty in body coordinates , 

as a result of axtarnal forces acting on the vehicle is described 
2 


•(B) 

V 


, - ,(B) ,(B) 

B I { ’) (I) (B) ^ jf 

— c^^Ca (r )-wxv 


(B) 

V 

by 


( 20 ) 


where 

p > atmospheric density 

A » aerodynamic coefficient referenced area 

V m magnitude of vehicle velocity relative to the surrounding air 


mass 
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ra s \>ehicle mass 

“ aerodynonic force coefficient vector 

(r^^^) « gravity vector in inertial coordinates 
^ = angular rotation of the body relative to the inertial frame 
(B ) 

f' » resultant thrust force vector in body coordinates 
-T 

(B ) 

fp 3 resultant plume force vector in body coordinates 

The rate of change of vehicle position in inertial coordinates, 
is then obtained by 


•(I) IB (B) 
r = C v 


(21 ) 


1 B 

where C is the transformation matrix from body coordinates to 

I B 

inertial coordinates . The elements of the C transformation matrix 
are obtained from the resulting E^le:* angles defined by 




1 sin(ptan6 cosftanB 


P 

• 

e 

3 

0 COS9 -sinv 


q 

- . 


0 sintpsecO cosfsecB 


r 

- «. 


where (p, 6, and 4> are roll, pitch and yaw attitudes respectively. 

The roll, pitch and yaw rates of the body relative to inertial coordinates 
are p, q, and r respectively. Finally, the rate of change of the body 
rates relative to inertial is given by 
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III*"* t 


PAV 


m 


PAv" 


ic 


(r 


(B) 


-eg 


xc^ 


- Ill X (Tw) 


m<B) 

+ 5m 

— T 




(23) 


t^ere 


I = vehicle moments of inertia matrix 

ic_ s aerodynamic coefficient referenced length and moment 

IQ 

coefficient vector 

(B) 

r^^ - vehicle center-of -gravity vector in body coordinates 

(B) 

- aerodynamic coefficient reference position in body coordinates 
(B) 

- resultant thrust torque vector in body coordinates 
(b) 

T„ s resul nt plane torque vector in body coordinates 


Ihe equations of motion represent the first twelve eluents of the system 
state vector. These equations are summarized in Table 3.1 .1-1. 

The moment of inertia matrix I in general is given by 



I 

-I 

-I 


X 

xy 

zx 

I = 

-I 

I 

-I 


xy 

y 

yz 


-I 

-I 

I 


zx 

yz 

z 

for the moment 

axis terms , 

i.e. t 


U4) 


and the product of inertia terms, 


Equations of Motion 
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Itie aerodynamic force and moment coefficien^^m^A|?l|l|[^f.rf qi^es are 
defined as functions of angle -of -attack, a, and angle -of -sideslip, 0, as 
shovm in Figure 3. 1.1-1. The body referenced relative velocity vector, 
removing the wind velocity, v^, from the vehicle velocity, is given by 


(B) B I 
V a V - C V 


(B) B LL (LL) 
V - C V 


(25) 


where is the local -level referenced wind velocity vector. The 

following equations define a and B in terms of the components of v 


. -1 , ^3 , 

o = tan (— — ) 

V 

^1 


(26) 


v^ 

B = sin'^ ( — ^) 
v 
m 


(27) 


where 


m 


(v ^ + V ^ + V ^) 
^1 ^2 ^3 


(28) 


The resultant thrust force f„ 


(B) 


-T 1=1 1 


'A T 

"^i ! 
0 ! 

0 I 


is expanded as 


■ i=1 -T^ 


(29) 


B ^ 

where the transformation matrix transforms the magnitude of thrust 

for each thrusting device, f^ , from its center-line to the body 

i 

coordinates. The general equation for is 

i 
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- -PA 

T. 8. e 

ivac i 


vrtiera 


vacuum thrust 


ivac 


P ■ atmospheric pressure at motor exit 
s . 

1 


A B motor exit cone area 
e 


Ihe matrix ®C^ is different for the SSME's and SRB’s and is given by 
^ B^MP MP^G. G^<L SSME 




( 30 ) 




SRB 


\diere 

= transformation from the engine mount plane to the body 
coordinates 

- transformation from the gimbal reference plane to mount plane 
(structural deformation) 

3 transformation from enterline to the gimbal reference plane 

= transformation from SRB nozzle centerline to the body 
coordinates (gimbal angles ) . 
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Ihe resultant thrust torque is the sunmation of the torque contribution 
from each thrusting device and is given by 


-T 


i-1 


/ (B) 

-T. 

1 


(B). B_<1 

r ) X C, 

-eg 1 


(31 ) 


where 



= body coordinates of the 


thrust reference point for the 


.th 

1 


thrusting device. 


3.1.2 Measurement Equations 

The measurements assumed available for the filter /smoother algorithm 
include inertial platform acceleration and attitudes < ground based radar 
traclcingi SRB's head pressure, SSME' s chamber pressures, liquid flow 
rates, pressurant flow rates. The ET volumetric levels are available; 
however, due to their limited number (4), they may only be used for 
alternate checks of the filter/sraoother algorithm performance. 

The propulsion related measurements will be treated in a separate 
section. In the following, the inertial platform acceleration measurements, 
attitude measurements and ground based tracking measurements models will 
be described for later linearization. 
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3. 1.2.1 Platform Acceleration MeaBurements 

Accelerometers mounted orthogonally on an inertially stabilized 
platform, not located at the vehicle center of gravity, sense externally 
applied special forces and accelerations due to body rotation. Ihe 
accelenxneter measurement is modeled by 


a<=> 

-m 


ScP 




P' B 


pAv 


m 







+ U) X U X 




(B). 
- r ) 
-eg 


-I- u X 


, (B) 


<B). . 
- r ) J 
-eg 


+ b 


(S) 


+ V 


(S) 


(32) 


v^ere 

S P 

C ■ transformation from platform coordinates to sensing coordinates 
P P' 

C = transformation from misaligned platform coordinates to 
platform coordinates 

p* B 

C s transformation from body to misaligned platform coordinates 
(B ) 

= body coord ‘nates of the platform center 
(S ) 

b > accelerometer bias vector 
-a 

v^^^ = accelerometer measurement noise vector 
-a 

3. 1.2. 2 Platform Attitude Measurements 

The inertially stabilized platform for the STS is a four axis IMU 
with a redundant roll axis [4l. Vehicle body attitudes cu*e generated 
via quaternions [5]. It is assumed that an equivalent representation 
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can be made to obtain vehicle attitude by a three rotation sequence of 
roll> pitch, yaw to transform fron inertial to body coordiantes. this 
approach has been used in reference [6]. 

Ihe attitude angle measurement model is given by 







(S) 


( 33 ) 


where 



platform misalignment bias vector (used to formulate 
3 attitude measurement noise vector. 


p^p. 


) 


Ihe transformation matrix used to transform from body to inertial 
coordinates in terms of the elements of the 6 vector is given by 


cos6cos(|> 

sin9sin6cos<t> 

cosfs in6cos4* 


-cos(psin(|« 

-»' 8 infsin 4 ' 

cos6sini|r 

sin(psin0sin4» 

cosip 8 in 6 sin 4 > 


4COS(pCOS<t< 

-8infcos<|* 

-sin0 

sin(pcos6 

COS9CO80 


( 34 ) 


3.1 . 2.3 Ground Based Tracking Measurements 

Ground based radar tracking devices cam provide measurements of 
range, azimuth and elevation from the radar sight to the vehicle. Azimuth 
and elevation are established relative to the sight's local level. If 
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the tracking device is a passive optical tracker (not laser) then only 
azimuth and elevation measurements are available requiring more than one 
to establish position information. 

Defining x» y, and z as the local east> north and up position of the 
vehicle relative to the ground based tracking device • the radar measur«nent 
equations are given by 

p ■ (x^ + y^ + z^) + b + V (35) 

P P 

A m tan’^ (— ) + b- + V, (36) 

y A A 

E - tan"^ ( ) + b_ + AE + v_ (37) 

^ri r ^ ® 

Y X + y 

idiere 


b 

P 

AE 


f 


V 


b^, bg « range > azimuth, elevation biases 

- atmospheric refraction correction 
v^, Vg » range, azimuth, elevation measurement noise. 


The position vector of the vehicle relative to the tracking device is 
given by 


fxl 


y 


A . (LL) 
= ^£v 


LL^ECF rECF^ECI (I) (ECF), 

C ‘ c L -E«or ’ 


(38) 


z 
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vrt\«re 

LL ECF 

C - transformation from earth center fixed to local level 
ECF ECI 

C ■ earth centered Inertial to earth centered fixed 
(ECF ) 

r^j^ - position vector of tracking device in ECF coordinates > 

LL ECF 

The transformation matrix C is given hy 


i -sinX 

1 

>sinLcosX 

cosLcosX 

ECF LL -a ! COSX 
^ ; 

-sinLsinX 

cosLsinX 

I 0 

cosL 

sinL 


( 39 ) 


where L and X are the geodetic latitude and east longitude of the 

ECF ECI 

device. The transformation matrix C is given by 


ECF„ECI 

C 


“•‘“e" - 'rmp” 

sin[u) (t 
£ 

" ^RNP^^ 


cos [(*>_( t 
£ 

^RNP^^ 

0 

0 



[RNP] 


( 40 ) 


where 


u)^ ■ earth rotation rate 
^RNP “ matrix 


The position vector, 


(ECF) 

' 


of the tracking device is given by 


0RIQW4AL : j 
OF POOH QUALrfY, 


(ECP) 


( 


( 


( 


h__ 

V cos^L + (1 - *)^ sin^L 
yj cos^L + (1 - sin^L 

V' 

V cos^L + (1 - iln^L 


•f h) cosLcoaX 


■f h) coaLsinX 


+ h } ainL 


%rt\era 

■> equatorial radiua of Fisher ellipsoid 
e = flattening of Fisher ellipsoid 
h m altitude of the device above Fisher ellipsoid 
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3.2 Lin^arizxl 9y«tiro Stat# and M»a«ur«wnt Eqmationa 

'n\« v»hicl« •quationa of motion ara nonlinaar functions of thair 
motion variabXas and ara implicit functions of othar alamants of tha 
syst«n statas. Tha maasuramant aquations involva similar function rala- 

tionships. l!ha linaarizations for tha f iltar/smoothar algorithm raquira 

(B ) 

partial darivativas with raspact to tha motion variablas» i.a.* v atul 
8t and with raspact to othar alamants of tha stata vactor, yialding 
aj^licit furctional ralationshipr for tha alamants of intarast. 

for systam state aquations tha partial darivativas will ba prasantad 
in saction 3.2.1 for tha stata alamants in ordar of occurranca for tha 
first twalva statas. Othar partial darivativas for candidata stata ala- 
mants will follow in saction 3.3.1. Tha maasuramant aquation partial 
darivativas for tha first twalva statas bill ba prasantad in saction 3.2.2. 
Partial darivativas of tlM maasuramant aquations for othar candidatai xtatas 
will be prasantad in saction 3.3.?. 

The resulting partial darivativas ara imbedded into tha linearized 
system state matriXt F(x(t)i t), as shown in Figure 3.2-1 A corresponding 
linearized raeasuremant matrix, is similarly formed with thiit 

maasuramant aquations' partial darivativas. 

3.2.1 System State Partial Darivativas 

P«u:tial derivatives of each of the equatiors listed in Figure 3.2-1 
are developed in their order of occurrence with respect to the order of 
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the corrasponding states. Partial derivatives of thrust terms are presented 
as though for a single device. 


Inertial Position Rate Equation 


The first nonzero partial derivative of the r equation is with 
respect to v 


0 

TbT > - = • 


The second nonzero partial derivative is with respect to 0_. This partial 
derivative results in a third order tensor and occurs frequently in later 
developments, ihe generalized form is presented in Appendix A. 


Pjdy Velocity Rate Equation 


The peurtial deriva<:,^ve of with respect to is given for 

altitude terms approximately as 


3 ^ 

g^(I) “ 3h , (I)| 


where 


3v^^^ Av^ a pAv 3v pAv^ 6c, - pAv^ 3c^ 

— m ^ m m m -f 3g m -f 36 

3h * 2rn 3h % ^ m ^ 3h ^ 2m 3o 3h ^ 2m 36 3h 


a 9P 

1 — r -p 

+ C — a — air a- + 

m 3p 3h 3h 

s 


3f^®^ 3f^®’ 

-y 3g ^ 36 . 

3a 3h 66 3h^ 
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0V 


m 


The partial derivatives of —7-, 


da 


80 


8v^®> ’ av<®^ ’ 


8a 80 


8v 


(B) ' 8h ’ 8h 


8v 


and 


m 


8h 


occur frequently and are given in Appendix B. 

The gravity vector partial derivative with respect 

. (I) . 

to r IS 


A (I), (1), 

B I * 2 . <£. ) 


8r 


(I) 




(I) 3 
r 


- 1 


,^ 1^2 


r 


T T 

£l 


- 1 




T T 
. 1 2 


T T 


- 1 


( 45 ) 


where 


U = gravitational constant. 

8v<«> 

The partial derivative, — , is the sum of the matricies in equations 
43 and 45 . 

•(B) ( B ) 

The partial derivative of ^ with respect to v is given by 


8v 


(B) 


8v 


(B) 


pAv 0 v 
m m 


pAv 8c- - 

m -f 8a 


90 


(B) 2 m 


8o , (B) 
8v 


2 ra 00 _ (B) 

0v 


+ L [!i£ _J2_ + !iE -Qg ] . 

m ^ 0o _ (B) 00 _ (B) ^ - 

ov ov 


( 46 ) 
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where 


« skew synunetric matrix made from the elements of the vector w 
and equivalent to the cross product operator m x ( ) . 


Hie partial derivative of 



with respect to 6 is 


5v^^^ pAv 3v 5v pAv ^ 3c. _ 3v 


38 


ra 3v 30 2m 3o 3v 30 


3B 3 ,B„I (I), (I),, 

+ -a;r“ s;r ^ 30 f c g. <r )] 


3f^®^ 3v 3f^®^ 3v 
L f ~P 3g -r -p 38 -r , 

m ^ 3o 3v 30 38 3v 30 ^ * 


(47) 


The partial derivatives of are given in Appendix B and the partial 

-r 

3v 

derivative is given in Appendix A. The last partial derivative 

00 


is given in )^pendix C. 


(B) 


The partial derivative of v with respect to m is 


3v 


(B) 


du) 


pAv 3c 


m 


2m 3w 


^ f (B), 
+ t-v + 


( 48 ) 
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Euler Angle Rate Equation 

The Euler angle rate eqpiation is a function of both the Euler angles 
and the inertial rates. The linearization vrill yield the two associated 
matricies. 

First with respect to the vector 0, the following matrix results 


ae 


r 2 2 

qcos<ptan9- rsinytanB qsin<psec 6 + rcosfsec 6 0 

I -qsinv - rcosv 0 0 

I I 

I qco 89 sec 0 - rsinfcos0 qsin<psec0tan0 + rcos<psec0tan0 0 j 


The partial derivative of 


0 with respect to (d is 


00 

ddi 



sin9tan0 

COS9 

sin 9 sec 0 


cos 9 tan 0 

-sinip 

cos 9 sec 0 


(50) 


Inertial Angular Acceleration Equation 

The first partial derivative of this equation is with respect to the 
vector Using the approximation indicated in equation 43, this 

partial derivative is 


! 

I 


(49) 


I 
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dui 


Adv 


8r 


(I) 


[I] ^ ^ c + (pv Adc + x pv Ac.)-^ 

2 oh -Ri ra -m -A -eg ^ m -€ 8h 


8v 


+ ( 


+ ( 


2 2 

, (B) (B). "'’m * to 

— 2 to ‘ 'i* ■ ^cg ’ ^ — 2— -to* 5h 


2 2 
^ , (B) (B), '"'m * “£f. BB 

—2— * ‘5:a - E=g > * —2— -86* 8h 


(51) 


0fl 'dp a T a T 


ax 


-d)' 


-T -eg ap ah ah aadh aa ah' i (i). 


(B ) 

Next> with respect to the veetor v ' , the partial derivative is 


= [I] ^ {(pv Ad c + (rf®^ - r^®^) x pv A 

ra -«i -A -eg ^ m -£ a.JB) 


3v 


(B) 


3v 


+ ( 


+ ( 


2 2 
pv Ad ac pv A 3c_ a 

m -m , (B) (B), ^ m -f , 3a 

2 3a -A -eg 2 3a ^ (B) 


3v 


2 2 
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2 aa -A -eg 2 38 ^ (B) 


(52) 
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to 86 , 

♦-to-7iT * toTTST* • 

3v 3v 
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Ihe partial derivative with respect to the vector 6 is 


— f-1-1 // , (B) (B). , . in 

SS* ” m npv ftd c + - r ) X pv A -rr- 

08 m -«i -A -eg m 08 


pv Ad 0c 


pv A 0c, 


~ ,(B) (B), 8a 

+ ( r- + (r, - r__ ) x — = -rr- 
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2 da' 08 


, (B) (B), ^2f . 0B 

^ 2 00 ^ ^ 2 00 ^ 08 


(53) 


9T a- 9T ao 

+ . -IE } 

+ 0a 00 ^ 00 00 


The final partial derivative for the first twelve states is with respect 
to the vector id. This operation yields 


0U 

0(D 


.-1 


pAdv 


0c 

-m 
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(B), 
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-eg 




( 54 ) 
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3.2.2 Measurement Partial Derivatives 

Itie measurements assumed to be available j as discussed earlier > include 
ground based radar tracking, inertially stabilized platform attitudes 
relative to the vehicle body, and stabilized platform mounted 3 axis 
orthogonal accelerations. As with the state dynonics matrix, the measure- 
ment equations are linearized about the best state estimates . 


Radar Track Measurement Bqpiation 

Referring to the rad^u^ track measurement equations, the required 
partial derivatives are 




ar 


(I) 


8p 

-V 


-V 


dr 
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(55) 
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(LL) 
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(57) 


aA 

aAr 

"V 

The last partial derivative in each of these equations, r~ , is 


ar 


(I) ' 


aA <LL) 

0Ar 

—V 


dr 
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The rest of the required partial derivatives are 


»e_ 


Sir"-*-’ 

-V 


. ir <*-*-’ 

-V 




( 59 ) 


8A 

—V 
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^ y 

I 2 2 ' 2 2 

X + y X + y 


. 01 


( 60 ) 


8E 


8Ar 


(LL) 


-xz 




%ri 2 

V X -h y 


2 x/ 2 2 2 J 2 2 

»Vx+y pVx+y 


] (61 ) 


Inertially Stabilized Platform Attitude Elquation 

The inertial platform is assumed to provide attitude angle measure- 
ments of the true attitude plus an attitude bias plus measurment noise . 

The partial derivative of the measured attitudes with respect to the 
vector 0 yields eui identity matrix. 

Accelerometer Measurement Equation 

The accelerometer senses specific body forces excluding gravity along 
the sensing axes. With reference to the accelerometer equation, the 
partial derivative with respect to is 
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(B) 

Ihe partial derivative with respect to ^ yields 
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(63) 


For the partial derivative of the accelerometer with respect to 
the vector 0, the measurement equation is temporarily rewritten as 


(S) S P' P' B (B) . (S) (S) 

a = C Cs +b +v 
-fli — —a — Q 


(64) 


( B ) 

where the vector a represents the sum of the aerodynamic > thrust • 

P’ B . 

plume and rotational coupling terms. The matrix C is the same 
I B 

matrix as C . The required partial derivative results from 
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a i_B (B) 


( 65 ) 


The partial derivative on the right hand side is developed in Appendix A 
( B ) 

with the vector £ representing the sum of the terms indicated above. 

The final partial derivative for the accelerometer measurement is 
with respect to the body rotation vector u. Defining 








r«>) 

-eg 


( 66 ) 


and denoting as the i^** element of the vector u, the resulting 

matrix is 
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3.2.3 Additional Parameter Partial Drivative a 

The mathematical developments are presented in this section for the 

partial derivatives of the system and measurement equations to allow for 

additional candidate parwneters to be included in the estimation algorithms. 

These parameters include center-of -gravity, r , moments of inertia, 1, 

-eg 

wind velocity, v^, and inertial platform tilt errors. Aerodynamic and 
plisne parameter partial derivatives are also presented. 

The computer program is being structured to permit these paraneters 
to be easily incorporated without significant impact on the program code. 


3. 2. 3.1 Center-of -Gravi ty 

From equation 23, the p6urtial derivative of angular acceleration with 

respect to r is 
-eg 


dw 

dr 

-eg 


[I]-' [ 


— + .1. 

— f 1»1 1 


T. 

1 


i] 


( 68 ) 


From equation 32, the partial derivative of the measured ^ ^eleration with 

resr ?ct to r is 
-eg 


-tn 


- C fu X 


vo9 ) 
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3 . 2 . 3 . r Mownt» of InTtia 

Th* moments-of>inertia are grouped into "principal" tertna, 

erots product terme, i Fran equation 24, these vectors are 

-cp 



and 
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-cp 


' I 


xy 


I I 

I zx 
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With these definitions, equation 23 is rewritten as 
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where £T represents the sum of the nonrotatlonal torques in equation 
D' fining an intermediate vector a as 

a ■ IT - « X (Iw) 


the partial derivatives of the angular acceleration with respect to 
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and i are 
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where 


39 


ORIGINAL PAGE 13 
OF POOR QUALITY 


0 .1 1 

TT— (1 a) ■ — I I a_ 1 a, 

oi — A ' 2 2 yz 3 

“P 


I a, I a^ 
r y 3 yz 2 


I a. + I a. 
z 1 zx 3 


1 a_ + I a, 
X 3 zx 1 


I a, -f Z a. 
y 1 xy 2 


I a, I a, 
X xy 1 


(II - I ^)a, 
y z ya 1 


(I]"’ J- ( 

a 


)a 


2 

)a. 


(II - I )a, 
X z zx 1 


)a 


2 

)a. 


(II - I )a, 
X y xy 1 


2 

)a. 


and 


_8 

Oi 

-cp 


(!"’ a) 


(76) 


(77) 


1 

A 


I a* + I a_ 
z 2 yz 3 


I a, + I a, 
z 1 zx 3 


I a_ + I a_ 
y 3 yz 2 


I a, - 21 a. + I a. 
yz 1 zx 2 xy 3 


1 a, + I a„ - 21 a. 
yz 1 zx 2 xy 3 


I a, + I a_ 
y 1 xy 2 


'21 a, + I a. + I a, 
yz 1 zx 2 xy 3 


I a I a« 
X j zx 1 


I a + I a, 
X 2 xy 1 


40 


OR'iQtWAL PAGE *3 

OF POOH QUALITY 



-2(1 I + 

I I )a, 

-2(11 4 

I I )a. 

-2(1 I 

+ 

I I )a. 


z xy 

zx yz 1 

y zx 

xy yz 1 

X yz 


xy xz 1 

[I]”^ 7 
a 

-2( 


-2( 

^*2 

-2( 

II 



-2( 

^^3 

-2( '• 

^‘3 

-2( 

) 

^*3 


and 


III 
X y z 


-III 
xy yz zx 


-III 
zx xy yz 


II 
y zx 


I I 
z xy 


- I I 
X yz 


(78) 


3.2 .3 .3 Wind Velocity 

From equations 20 and 25, the partial derivative of the vehicle 
acceleration with respect to v is 
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(79) 


The first of the partial derivatives in equation 79 can be obtained 
from the following equation 


2 T (B)"^ (B) (B)"^ B^ T B B^ 
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From equation 80 , the following is obtained 
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Denoting the elements of the matrix C as ®tc., the following 

equations are obtained for the partial derivatives of o and 6 with 
respect to v ; 


da 
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V + V 

r r 
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<''r,=33 
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and 
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(83) 


3. 2. 3. 4 Inertial Platform Tilt 


Temporarily rewriting equation (32) as 

(S) S . 

a = C(I+66x)s 


(84 ) 
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where 


68 a ^«ctor v^ose elements are the axes misalignments 

P ' 6 

s a sum of the bracketed tains in equation 32 multiplied by C . 


H\e following partial derivative of the measured acceleration with 
respect to 66 is obtained 


da 

-m 


(S) 


666 


= C ^-Si, 


(85) 


3. 2. 3. 5 Aerodynamic and Plume Parameters 

A linear model for the aerodynamic and plume characteristics i s 
used. This model is expeinded as 
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( 88 ) 


where additional terms to represent rates, cross couplings, and controls 
can be included. 

The basic approach of estcblishing the partial derivatives will be 

illustrated for a couple of terms, c_ and c . Using these example 

-fo -mo ^ 


f 
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illustrations, the rest of the candidate parameters can be similarly 
obtained. From equation 20, the fallowing partial derivative is obtained 


3v^®^ 3v^®^ 8c^ 

®£f “ 


where 


[U] * unit 3x3 matrix vith oie's (1 ) on the diagonal and zeros 
off the diagonal 


From equation 23, the pjrt'ai derivatiw of angular acceleration with 

respect to c is 

■‘a 
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'Ihe corresponding partial derivative with respect to c_ is 
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Ihe static aerodynamic coefficient model has been obtained by a multiple 


regression analysis of the current aerodynamic tabular data. This model 


is presented in Appendix D with the associated regression coefficients. 


3 .3 Propulsion Parameter States and Measurements 


A candidate approach for incorporating the NASA propulsion model's 
capabilities has been identified. This approach utili 2 »s nominal pre- 
dicted values of thrust, pressure, propellant and pressurant mass flow 
rates, and utilizes sensitivities or partial derivati'.’es of these 
variables with respect to the independent parameters selected for esti- 
mation by the algorithm. 

The approach is to include deviations from nominal values of 
measured chamber pressure, power level, propellant and pressurant mass 
flow rates as states . The models assumed for these deviations are time 
correlated random processes. Then as states, partial derivatives of 
the first twelve states with respect to these variables will be required. 

For the SSME and SRB, this modeling aji^roach is discussed in the 
following. Additionally, the necessary partial derivatives of the first 
twelve state variables with resepct to the additional states are presented. 

3.3.1 SSME Propulsion Parameter Model 

For the SSME, the total actual values of vacuum thrust and oxidizer 
mass flow rates are modeled by 

f„ * f„ + (92) 

T T T 

r.om 

and 

e e e 

m = m + Am . (93) 

°2 ^2 °2 
nom 
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The measurements of fuel mass flow rate> pressurant mass flow rates and 
power level are modeled as 



m. 
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H, 
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^md 


PL » PL + APL + b„, + s„, . (97) 

nom PL PL 

These measured quantities include measurement noise s ^ ^ and potenti6d. 
bias states b^ ^ modeled as random constants. In these measurements > 
the A'd variables are to be included as states in the estimation 
algorithm. If the nominal values are zero or unknown, then the A'd 
variables absorb the entire estimate. Where required, the estimate for 
the variables used in the estimation algorithm is formed using the 
nominal and the estimate of the deviation, etc. In example, thrust and 
fuel mass flow rate estimates are formed as 
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T 



+ Af 
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nom 


(98) 
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(99) 


Ihe deviation or A'd measurement variables are modeled as time 
correlated random variables . This permits these variables to vary within 
a band of frequencies. The typical model is then given as 


— A( ) - - ~ A( ) + 1 


( ) 


( 100 ) 


where the parenthesis ( ) would be replaced by the variables, i.e., m 

. 2 

For the SSME, an additional variable Ac is modeled as in equation 

mult 

100 and included as a state variable with the A'd measurement 
variables . 

The thrust deviation is expemded as in the following truncated Taylor 
series as a function of the independent paurameters. 


Af 
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(101 ) 


• (B) * 

In the ^ and w equations, with equation 101 replacing f 


T. 


1 

the partial derivatives of with respect to the A'd variables are 

obtained directly from equation 101. 
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It is desirable to include vehicle mass bias as a state. The SSME's 
system contribution to the mass deviation is given by 


■ 3E(Am„ + Zm_ 
SSME's ^ ©2 

^i i 


- 


Pi 



( 102 ) 


In equation 101, the M contribution to the mass deviation is not 

°2 

available from measuronents . As with the thrust deviation, this (juantity 
is formed as 
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apL 
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5MR 


AMR. 


(103) 


\diich is in terms of other estimated state variables . In equations 1 01 
and 103 the deviation in mixture ratio, AMR, is obtained algebraically 
from 


AMR 



nora 




dMR 


(104) 


The partial derivatives for the SSME above have been incorporated into 
the estimation algorithm as functions of engine power level . 
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3.3.2 SRB Propulsion Parameter Model 

Ihe approach for the SRB modeling follows closely that used for the 

SSME. Candidate independent parameters include propellant bum rate 

exponent, a, and motor efficiency coefficient, c . Others can be added 

m 

using this technique. 

The actual value of vacuum thrust is given by equation 92 . The 
only measurement available for the SRB is the total pressure at the 
forward head end of the motor case and is modeled as 




nom 


+ AP, 


+ b + s 



(105 ) 


where b^ ^ and ^ represents a bias and measurement noise respectively. 

The independent paraneters, Aa and Ac , are included in the 

m 

model as states. The model assumed can be as given by equation 100 or 
another suitable dynamical process , i .e . , random constant . 

The thrust deviation is given by the following truncated Taylor 
series as a function of the candidate independent penrameters. 


Af 
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Ac + . . . 
m 


( 106 ) 


•(B) • 

The partial derivatives for the ^ and ui equations with resp>ect to 
the independent parameters are obtained directly from ec^uation 106 . The 
mass deviation equation for the SRB is given as 

i 



AmsRB = J(Am) 
1 1 


( 107 ) 
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whore 



am 


ia. ■¥ . . . 


The head pressure deviation, 




da 


Aa + . . . 


AP , is expanded similarly 
H 


( 108 ) 


( 109 ) 


A simplified model for the SRB's thrust, head pressure and mass flow 
rate has been developed that can be directly incorporated within the filter 
algorithm for estimating turn rate coefficient, nozzle coefficient, mass 
flow rate, etc. This model, to be described below, uses apriori specified 
bum area and port volume as a function of burn depth into the propellant 
grain. From this simplified model analytical partial derivatives required 
by the estimation algorithm can be obtained. 

The thrust is given by 

* °m °T 

where 


c = nozzle coefficient 
m 

= thrust coefficient 

it 

c = characteristic exhaust velocity 
m = mass flow rate 
g » gravity acceleration 

TWO of the required partial derivatives with respect to mass flow rate 
and nozzle coefficient are easily obtained, vis 
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Iha partial darlvativa with raspact to bum rata coafficiant la 


0c„ 8P. • 

T , T O • 8m , * 

8a ■ ^8P^ 8a “ 8a °T^ ° ®m 


whara It has batti assumed tiiat c is not a function of a. Using tha 


"ideal" expression for [7] 


ri 5±i 

.V 2ll (-2_)T-1 

T Y-1 T+1 


[1 - 


Izi 


P - P A 
e a e 


where 


y ■ ratio of specific heats 

P > motor nozzle exit pressure 

P^ m ambient atmospheric pressure at nozzle exit 

A B motor nozzle exit area 
e 

A B motor nozzle throat area« 


the first partial derivative in equation 113 is 
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t1 - (~) 
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Tb avaluata the aacond ;)artial darlvativa in aquation 113, tha following 
aquation for prasaura [8] la uaad: 
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**0 - < A 


c a A. ; — 

LE l£j-" 


( 116 ) 


whara 


■ propellant danaity 
m propallant bum araa 
n m propallant bum rata axponant 


lha following partial darlvativa ia than obtained 
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Ihe laat partial dc ivative in equation 1 1 3 ia obtained from 


n 

* , 1 -n 

. c p a Ajj 

" - Pp \ % “‘TX — ' -S,' 

The resulting partial derivative is 
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7b utiliza th« haad praaaura roMauraiBant and its smsitivlty to 
psrsmstar variations! tha following aquation [7] is usad 



^ [t 


4RT( 


cr. P i 

P- p , 

P 0 


■)3 


(1 20) 


%<hara 

R ■ gas constant 
T ■ gas absoluta tamparat\ura 
a m port circumfaranca 

■ port cross saction araa 
m propallant bur.t rata 

I m distanca fro<n .^ot-or nozzla to prassura roaasuranimt point 


This aquation assumas a cylindrical port with an approximataly constant 
cross sactional area. 


c£ 


With this assumption ~ baccmas 

P f P 


y/ . 


P« r. 


n-1 

* - 1 -n 

° "p • *b, 


Also racognizing that 
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"r ‘b _ n-1 "p " "b. ° ® \ 
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Pq "p- 0 
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° K 


than aquation (1 20 ) can ba rawrittan as 


Pft .3 A. 


•) ]. 

H P ° 

Ihe partial derivatives with respect to burn rate coefficient and mass 
flow rate are 
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/ 9 ^ \ 2 

1, [1 +t 1 + 161 RT 
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4RT 
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1 + 4RT(^) 
P -0 


“ / 


<122) 


1 + 4RT(-^) 
P 0 


In •quatlons 121 and 122 a cylindrical port haa baan asaumad In datamlnlnq 
tha port voluma V^. Bqpjatlon 122 waa obtained from aquation 120 by 
raplaolnq tha term o r. p t by tS. lha partial darlvativa of P 

op Ojj 

with raapaot to c la obvloualy zaro. In ualng thaaa analytical 
m 

partial darlvatlvaa* tha baalc parformanca maaauraa of thruati maaa flow 

rata> haad and nozzla praaauraC) ate. ara matchad bat%i.aan thla modal and 

tha NASA SOBER intamal balllatlca routlna raaulta. Tha bum araa and 

port voluma ara adjuacad In tha almpla modal to obtain tha agraamant. 

Than using tha adjustad araa and voluma as a function of bum dapth> tha 

partial darlvatlvas ara avalautad. 

Tha Inclusion of solid propellant thickness, t, as a state variable 

necessitates the development of the partial derivatives of t with respect 

to the solid propulsion parameters and the partial derivative of the 

measurement P. with respect to \ . These partial derivatives are given 
H 

as 


8t 

8a 
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1 -n 
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Here I the partial derivatives of c , A^, and with respect to t are 
evaluated numerically. 

Finally* the partial derivative of thrust with respect to t is 
given by 


It” " at” \ a^ 
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(1 24) 
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3.3.3 Vahicla Hass 

1h9 toted rate of change of vehicle mass is given by 


dt^) ’ "SSME "SRB ^SSME ^SRB '“nON-C»NSUME 

nom nom 


Ihe first two terns in this equation are the apriori assumed nominal 
values. Iha third and fourth terms were discussed earlier. The last 
term should be zero; however it can include a mass bias uncertainty Am. 
Ihe equations 1 state and measurement, in v^ich mass occurs are the 

* (B) 

V auid a^ equations. Assuming equation 123 can be summarized as 

• • • 

m + then the mass can be written as m + Am^. Replacing this 

expression for the mass in the two indicated equations yields the 

following partial derivatives with respect to the Am. . 
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dv 
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4.0 COMPUTER PROGRAM DESCRIPTIONS 

The optimal estimation techniques described in the previous sections 
have bean implemented into two computer programs which reside in NASA's 
VAX computer. These programs are structured in a highly modular approach 
facilit«:ting easy modification and additions. The two programs j identified 
in VAX nomenclature as FILTBR.EXE and SMOOTH.EXE, are described below. 

The linearized state and measurement equations implemented into the programs 
are shown in Figures 4.0-1 and 4.0-2, with the indicated partial derivatives 
developed in Section 3.0. A listing of the FORTRAN code for these two 
programs are provided in Volumn II of this report. 

4.1 FILTER Program Dsscription 

The interconnection of the major routines for the FILTER program is 
shown in Figure 4.1-1 . The basic flow of the program is a sequential pro- 
cessing of measured data available at discrete time instcinces and propagating 
the state estimate vector and error covariance matrix forwauid. to the next 
time measurements are available. 

Between measurements, the state vector, formed in XDVEC, and the error 
covariance matrix, formed in PIX4TRX, are propagated forward (integrated in 
time) using a Ringe-i^tta fourth order numerical integration algorithm 
RK4FIL. The subroutine GETDAT reads the measurement data from disk file 
INPUT. DAT. The subroutine MEASUR calls the various routines to update the 
state estimate based on available measurement data. These routines are: 

RADAR for radar azimuth, elevation and range data for three radars; 

ACCEL for three axis accelerometer measurements on the insrtially stabilized 
platform; ATTIT for the attitudes available from the platform; SSME for the 
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FIGURE 4.0-1 


Linearized Systan Matrix for Ekjuation (3) 
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FIGURE 4.1-1. Filter Program ^bjor Routine Linkage 









FILTER PROGRAM ROUTINE DESCRIPTIONS 




. 1 1 'ir ' iqum i j 



TABLE 4.1-1 (Oontinued) 



Provides the linearization of the dynamics equation with respect to the state 
elements as given by equation (3) - called by PDMTRX 




64 




four maasuramants of tha prasauranta ( 2 ), liquid nydrogm «nd powar laval 
for aach main angina; and SRB for tha ha^ atagnation praaaura maaauramant 
for aach rocket lx>oatar. 

Other routinaa provida raaulta of varioua calculationa and thaaa 
routinaa ara givan in Ttebla 4.1-1. A library of routinaa providaa varioua 
rapatitiva operationa and ara givan in 'Sabla 4.1-2. 

4.2 S?OOTH Progran Daacription 

The Knoothing progrsn ia aimilar to the filtering program in that input 
data are aaquantially procaaaad at diacrata tima in8ta.icea. Hoi^avar, in 
thia algorithm > the input data are data proceaaed by the filtering program 
and the aaquence ia in revaraad time. %e program ia aimpler in atructura 
and tha major routinea intarconnection ia ahovm in Figura 4.2-1. Iha data 
from tha filtering program ia read in aubroutine INPUT. Ihe propagation 
backwards in time of tha smooth adjoint state vector and matrix ia accom- 
plished in PROPAB using a state transition matrix formed in STRANS. Iha 
smoothed states aura updated in subroutine UPDATE. 

Ihe other routines used in the smoothing program au:e described in 


Table 4.2-1 . 
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4.3 Program Qfokout ar^ Pfliwinary 

Tha eonputar program, FILTER, haa baan chaekad out in a two atap 
procota. Plrat, to aatablijh confidanea in tha Implamantation of tha 
aquat <8 of motion and all tha raciirad data, tha program waa opar&tad 
in a atata vactor propagation forward in tima or aimulation moda. Thia 
moda corraaponda to an ITYPB paramatar valua of zaro. Tha firat ataga 
phaaa of llight waa "aimul.ataf? ** with tha vahicla attituda tima hiatory 
praacribad by tha nominal attituda varaua valocity coni.«and8. During thia 
mooa of oparation, arrora rapraaanting maaauramant uncarvainty wara addad 
to tha uncorruptad maaaurcmant valuaa for latar procaaainv by tha filtar 
program in a ITYPE aquala ona moda. Tha rasulta of thia opa^ction yialdad 
an input fila, INPUT. DAT, aa praaantad in Volumn II. 

Fbr tha initial chackout, only maaavirmn^nt arrort wara incl.>dad for 
tha filtar program chackout. With thaaa baing tha only arrora, aatLmataa 
producad by tha filtar program ahmild ba zero or vary email. Since thaaa 
aatimataa are ramdcmi varlablaa, tha mean valua of thaaa aatimataa ahould 
alao ba zaro, howavar, thia was not guantif.ativaly avaluatad in tha initial 
chackout . 

Using tha data generated in tha simulation mode, tha filter program 
was checked out. ihe objective in checking tha program out is to evaluate 
several attributes of the system model and the significance of tif 
maasuremants. ihe system model formulated should provide adequate sensi^ 
tivity of the state elonents to the error parameters included in the mudel 
(reachability). Also, via measurements are estimates of tlte error parameters 
produced with continually modified uncertainty (observability). *910 
uncactainty of tha errors should become smaller with each additional 
measurement update sequence for the estimates to converge ho their 


appropriate values. Ihese attributes result from the structural properties 
of the system model and measurements and could be evaluated by more formal 
processes I however i due to the size and complexity of the problem here> 
qualitative observations of the filter's operation will be used to Illustrate 
these properties. 

Ihe data from the example output listing FILTER. OAT in Volume. 12 is 
the basis of the discussions of the preliminary results of the filter 
program. These data are generated by the filter program for later processing 
by the maoother program. 

Before discussing these data, some observations resulting from the 
Initial attempts at operating the program are mentioned. It was discovered 
that the selection of state and parameter uncertainties and measurement 
error uncertainties is crucial to the filter program proper operation and 
stability. This is the result of two characteristics; the first is the 
fact that the extends i Kalman filter algorithm's performance relies on the 
accuracy of the estimates produced, and the second Is that the propulsion 
parameters produce a very strong Influence on all the syston state elemmts. 
This highly coupled system, while Initially causing some difficulty in 
mmning the program, indicates the potential for providing good estimates 
for all the parameters modeled. 

In the FILTER.DAT listing are oresented the results for one completed 
measurement sequence of the program. In this listing are the results of 
updates from two radars (RADAR), three axes of acceleration (ACCEL), and 
attitude (ATTIT), four measurements for eaK3h of the three main engines (SSME) 
and the raeasurem«nt from each <>f the two solid rocket boosters (SRB). 

Output for each measurement are: the 39 state estimate values, the 39 

diagonal elements of the estimv.tion error covariance matrix, the value of 
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the residual (differmce between the measuremwit and the estimate of the 

measurement formed from the state estimates ) and the inverse of the quantity 
T 

(H P (-f)H -f R) - a scalar, and 39 values of the appropriate row of the 

Iv 

linearised measurement matrix presented in Figure 4.0-2. Ebr initial 
checkout purposes, the update interval was selected as one-tenth of a 
secmd for all the measuremaits . Ohis interval can be later modified as 
appropriate for each measurement processed. 

Scanning the state estimates produced by the filter shows that as a 
result of each measurement, the values of the states eure modified by the 
measuremwt update. Ihe significance of the measurenent is reflected 
by the reduced estimate uncertainty as q[uantified by the change in the 
estimate error variance reduction. After propagation up to the measuremmt 
time, it is seen from the data that the most significant meaeurements for 
the propulsion parameter elements 16 through 39 are the accelerometer, SSME, 
and SRB measurem«its . However, the radar and attitude measuremoits also 
produce reduced estimation error variances in these parameters in addition 
to the main state elements of position, velocity, attitude, etc. Ihe 
significance of this is the ability to provide estimates of biases in 
the accelerometer, SSME and SRB if present. Also of significance is the 
fcK:t that SSME measurement updates reduce uncertainty in SRB parameters 
and visa versa, ihis is again the result of the highly coupled system 
model and measurements. The individuality of the three SSME's parameter 
estimates is maintained by the filter. Ihis is contributed to by the 
structural deformation values used since the SSME gimbal angles used are 
the nominal cant angles, ihis can be seen in the accelerometer updates. 

Ihe final point to emphasize is the ability to reduce the uncertainty of 
the vehicle mass, ihis is the result of the accelerometer, SSME cind SRB 


measurements. 


. . 
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Iheso preliminary results indicate the possibility of the filter 
being able to provide estimates of the propulsion parameters from either 
the accelercxneter or SSME and SRB raeasurem«its > and certainly from both. 

Continued running of the filter with several more measurement update 
times showed continued improvement (reduction) of the estimation error 
covariance. However, after approximately 5 updates, some of the diagonal 
elements of the estimation error covariance became negative which is an 
indication of filter divergence. This problem can be rectified by proper 
selection of initial values for the state eoid peirameter error covariances 
and selection of measurement error levels, 'this "tuning" process should 
be done using real data rather than synthetic data. 
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APPENDIX A 


PARTIAL DERIVATIVE OF THE VECTOR V wrt 6 


Ohis partial derivative is one of severed that ocv^urs frequently in 
the formulation of the linearised system state and measuremetn eqautions. 
Ihe desired partial derivative is 


(cos6cos4> )v^ + 


.sin^sindcost)*. ^ .cos(psin9cos4> . ^ 
^-cos9sin(|> 2 >8in9sin<|> ^3 


8_ 

ae 


(cos9sin4*)v^ -»■ 


^sinysinOsinij* j ^ ^cos^psin0sin4» ^ ^ 
'+cos9COs4» v^ '^-sin9Cos4» ^3 


A-1 


(-sin0)v^ + (sin9cos0)v2 


+ (COS9CO80) v^ 


The resulting matrix is given in Table A-1 . 
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These partial derivatives occur frequently and will be developed 
in this appendix. The equation for v is 


(B) B LL (LL) 
V ■ V - C V 


B-1 


(LL) 


Since the wind velocity, v^ , is only a function of altitude then 
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The first partial derivative, 
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The second 


is given by 
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the following equations define the last three required partial derivatives 
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Oa B^LL ~w 


dv 
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APPENDIX c 

PARTIAL DERIVATIVE OF THE VECTOR V wrt 6 


The third of tha fraquantly occurring raquired partial darivativas 


is 



oos6cos4) 
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cosSsin^* 

sine 
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^sinf 8in6cos4> 
‘-co8Vsin4> ' 1 

+ 

^sinpBin9sin(t» 

' -fcospcos^* ^ 2 

+ sintpeose V. 


.cosf sindcos^* . 
'-HBin9sin4* 

+ 

.co898in6sin4» . 
-sin(pco8(|» ^2 

•f cos9cos6 V. 


The resulting matrix is given in Table C-1 . 
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APPENDIX D 

AERODYNAMIC MODELING REGRESSION ANALYSIS AND RESULTS 


lha aarodynamic data tablaa providad as IVBC3 data has baan incorporatad 
into an aerodynamic coafficiant polynomial modal. This modeling effort 
reduces the dimensionality of the numerical tables to one and reduces the 
storage requirements for the aerodynamic model. 

The coefficient model used for the two stages differ slightly as a 
result of the available data. The regression analysis led in the selection 
of the form cf the aerodynamic modal. Terms with insignificant correlation 
were eliminated from the model. 


In equation form, the first stage static coefficients of axial for , 
C^; normal force, C^; pitching mcxnent, C^; rolling moment, ; side force, 
C^; and yawing moment, C^; are given below 
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The corresponding second stage model is given by the following equations 
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D-12 


Ibr the first stage* data from an angle-of -attack reuige of -6 to +6 degrees 
was used in the regression analysis. Data from a range of -8 to +4 degrees 
was used for the second stage. The results* TCXX...* from the regression 
analysis is presented below for each of the coefficients, C , above. 
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